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(57) ABSTRACT 

A method of controlling a robotic manipulator of a force- or 
impedance-controlled robot within an unstructured work- 
space includes imposing a saturation limit on a static force 
applied by the manipulator to its surrounding environment, 
and may include determining a contact force between the 
manipulator and an object in the unstructured workspace, and 
executing a dynamic reflex when the contact force exceeds a 
threshold to thereby alleviate an inertial impulse not 
addressed by the saturation limited static force. The method 
may include calculating a required reflex torque to be 
imparted by a joint actuator to a robotic joint. A robotic 
system includes a robotic manipulator having an unstructured 
workspace and a controller that is electrically connected to 
the manipulator, and which controls the manipulator using 
force- or impedance-based commands. The controller, which 
is also disclosed herein, automatically imposes the saturation 
limit and may execute the dynamic reflex noted above. 

14 Claims, 2 Drawing Sheets 
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WORKSPACE SAFE OPERATION OF A 
FORCE- OR IMPEDANCE-CONTROLLED 
ROBOT 

STATEMENT REGARDING FEDERALLY 5 

SPONSORED RESEARCH OR DEVELOPMENT 

This invention was made with government support under 
NASA Space Act Agreement number SAA-AT-07-003. The 
invention described herein may be manufactured and used by 1 0 
or for the U.S. Government for U.S. Government (i.e., non- 
commercial) purposes without the payment of royalties 
thereon or therefor. 

TECHNICAL FIELD 15 

The present invention relates to the automatic control of a 
force- or impedance-controlled robot in an operating environ- 
ment in which a robotic manipulator of the robot may come 
into unexpected direct physical contact with an object and/or 20 
an operator within its workspace. 

BACKGROUND 

Robots are automated devices which are able to manipulate 2 5 
objects using a series of links. The links are interconnected by 
one or more actuator-driven robotic joints. Each joint in a 
typical robot represents at least one independent control vari- 
able, i.e., a degree of freedom. End-effectors are the particular 
manipulators used to perform a task at hand, such as grasping 30 
a work tool. Therefore, precise motion control of the robot by 
controlling its various robotic manipulators may be organized 
by the required level of task specification. The levels include 
object-level control, which describes the ability to control the 
behavior of an object held in a single or a cooperative grasp of 35 
the robot, end-effector control, i.e., control of the various 
manipulators such as robotic fingers and thumbs, and joint- 
level control. Collectively, the various control levels achieve 
the required mobility, dexterity, and work task-related func- 
tionality. 40 

Dexterous robots may be used where a direct interaction is 
required with devices or systems specifically designed for 
human use, i.e., devices requiring human-like levels of dex- 
terity to properly manipulate. The use of dexterous robots 
may also be preferred where a direct interaction is required 45 
with human operators, as the motion of the robot can be 
programmed to approximate human motion. Such robots are 
typically configured to operate in a well-defined or structured 
workspace. However, in certain evolving applications the 
designated workspace is relatively confined and/or unstruc- 50 
tured, and may be shared with human operators. In such an 
operating environment there is an increased likelihood that 
contact will occur in the workspace between the robotic 
manipulator and an object and/or human operator. 

55 

SUMMARY 

Accordingly, a method is disclosed herein for control of a 
force- or impedance-controlled dexterous robot within a 
robotic system. Such a robot may have one or more robotic 60 
manipulators. Each manipulator operates via a force- or 
impedance-based control framework within an unstructured 
workspace. As used herein, the terms “force-based” and 
“impedance-based” refer to the control of a robot relying on 
respective force or impedance commands and feedback sig- 65 
nals in order to move and apply forces through the various 
robotic joints and manipulators of the robot. 
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The present method at all times automatically imposes a 
saturation limit on a static force/torque commanded by a 
given robotic manipulator to its surrounding environment. 
Hence, should the robotic manipulator unexpectedly contact 
an object in its workspace, the static force applied by the 
manipulator is limited or bounded. Upon contact with the 
object, the robotic manipulator proceeds with its assigned 
operating task without “fighting” through the object after the 
object is encountered. This phase of the present control strat- 
egy does not rely on detecting the contact, but instead uses 
only proprioceptive sensing as disclosed herein to limit the 
static force at all times. 

Although the static force is bounded or saturation limited, 
due to momentum of the system when the robotic manipula- 
tor is in motion, the manipulator can impart a larger dynamic 
force at the moment of contact. Another phase of the control 
strategy may therefore include automatically executing a pre- 
determined dynamic reflex upon a threshold contact force 
with the object. The dynamic reflex alleviates any inertial 
impulse of the contact that is not already addressed by the 
saturation-limited static force. The dynamic reflex can rely on 
either dynamic modeling and/or exteroceptive sensing in 
order to detect the contact, i.e., physically sensing the contact 
such that the robot receives and responds to stimuli originat- 
ing from outside of its structure in order to identify the con- 
tact. In this maimer the robot can reduce the inertial impact to 
its manipulator which otherwise is addressed only by reduc- 
ing the mass and/or top speed of the manipulator. 

A method is disclosed herein for controlling a force- or 
impedance-controlled robot having a robotic manipulator and 
operating within an unstructured workspace. The method 
includes automatically imposing a saturation limit on a static 
force applied by the robotic manipulator to its surrounding 
environment such that the static force camiot at any time 
exceed the saturation limit. 

The saturation limit may be defined with respect to at least 
one of a torque in a joint of the robotic manipulator and a 
Cartesian force and moment at a selected point on the robotic 
manipulator. The method may further include determining a 
contact force between the robotic manipulator and an object 
when the robotic manipulator makes contact with the object 
in the unstructured workspace, and automatically executing a 
dynamic reflex of the manipulator when the contact force 
exceeds a calibrated threshold. 

A robotic system as set forth herein includes a controller 
and a force- or impedance-controlled robot having a robotic 
manipulator and an unstructured workspace. The controller 
imposes a saturation limit on a static force applied by the 
manipulator to its surrounding environment such that the 
static force cannot at any time exceed the saturation limit. 

A controller for a force- or impedance-controlled robot is 
also disclosed herein. The robot operates in an unstructured 
workspace and has a robotic manipulator. The controller 
includes a host machine programmed to automatically 
impose a saturation limit on a static force applied by the 
robotic manipulator to its surrounding environment, such that 
the static force cannot at any time exceed the saturation limit. 

The above features and advantages and other features and 
advantages of the present invention are readily apparent from 
the following detailed description of the best modes for car- 
rying out the invention when taken in connection with the 
accompanying drawings. 

BRIEF DESCRIPTION OF THE DRAWINGS 

FIG. 1 is a schematic illustration of a robotic system having 
a force- or impedance-controlled dexterous robot with 
robotic manipulators controlled as disclosed herein; 
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FIG. 2 is a logic control block diagram providing a control 
strategy for the robotic system shown in FIG. 1; and 

FIG. 3 is a flow chart describing a method for controlling 
the force- or impedance-controlled robot of FIG. 1. 

DESCRIPTION 

With reference to the drawings, wherein like reference 
numbers refer to the same or similar components throughout 
the several views, and beginning with FIG. 1 , a robotic system 
10 is shown having a dexterous robot 11, shown here in a 
humanoid embodiment, that is controlled via an electronic 
control unit or controller 12. Robot 11 is controlled using 
force- or impedance-based commands and feedback as noted 
above. 

Controller 12 provides a control strategy for the robot 11 
using an algorithm 100 as described below with reference to 
FIGS. 2 and 3. The control strategy provides a static compli- 
ance phase (control phase I) at all times, and may also provide 
an additional dynamic reflex phase (control phase II) to help 
ensure the safe operation of the robot 11 within an unstruc- 
tured workspace. The control phase(s) are executed by con- 
troller 12 via a joint torque command signal 50 calculated as 
set forth below and explained with reference to FIG. 2. 

As used herein, the term “unstructured” refers to an oper- 
ating environment or workspace which is at least partially 
undefined and/or shared with human operators or other 
objects, particularly where the objects/operators have an 
undeterminable or an unpredictable position. Such a work- 
space is defined in contrast to a typical structured robotic 
workspace having well-defined or clearly demarcated bound- 
aries. Structured workspaces allow objects having a highly 
regulated position and dimensions to be present within its 
boundaries, but do not permit human operators to be present 
within these boundaries. Evolving flexible automation may 
entail using a robot in workspaces which are largely unstruc- 
tured and/or are commonly shared with human operators, 
e.g., space exploration-based or industrial-based applica- 
tions. In such applications, a dexterous robot can execute 
certain work tasks requiring human-like levels of dexterity 
with a changing environment. 

The robot 11 of FIG. 1 may be adapted to perform auto- 
mated tasks with multiple degrees of freedom (DOF), and to 
perform other interactive tasks or control other integrated 
system components, e.g., clamping, lighting, relays, etc. 
According to one possible embodiment, the robot 11 may 
have a plurality of independently- and interdependently- 
moveable actuator-driven robotic joints, such as but not lim- 
ited to a shoulder joint, the position of which is generally 
indicated by arrow 13, an elbow joint that is generally (arrow 
15), a wrist joint (arrow 17), a neck joint (arrow 19), and a 
waist joint (arrow 21), as well as the various finger joints 
(arrow 23) positioned between the phalanges of each robotic 
finger 14. 

Each robotic joint may have one or more DOF. For 
example, certain compliant joints such as the shoulder joint 
(arrow 13) and the elbow joint (arrow 15) may have at least 
two DOF in the form of pitch and roll. Likewise, the neck joint 
(arrow 17) may have at least three DOF, while the waist and 
wrist (arrows 21 and 17, respectively) may have one or more 
DOF. Depending on task complexity, the robot 11 may move 
with over 42 DOF. Each robotic joint contains and is inter- 
nally driven by one or more actuators, e.g., joint motors, 
linear actuators, rotary actuators, and the like. 

The robot 11 may include components such as a head 16, 
torso 18, waist 20, amis 22, hands 24, fingers 14, and oppos- 
able thumbs 26, with the various joints noted above being 
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disposed within or between these components. The robot 11 
may also include a task-suitable fixture or base (not shown) 
such as legs, treads, or another moveable or fixed base 
depending on the particular application or intended use of the 
5 robot. A power supply 28 may be integrally mounted to the 
robot 11 , e.g., a rechargeable battery pack carried or worn on 
the back of the torso 18 or another suitable energy supply, or 
which may be attached remotely through a tethering cable, to 
provide sufficient electrical energy to the various joints for 
to movement of the same. 

The controller 12 provides precise motion control of the 
robot 11 , including control overthe fine and gross movements 
needed for manipulating an obj ect or work tool 3 0 that may be 
grasped by the fingers 14 and thumb 26 of one or more hands 
15 24. The controller 12 is able to independently control each 
robotic joint and other integrated system components in iso- 
lation from the other joints and system components, as well as 
to interdependently control a number of the joints to fully 
coordinate the actions of the multiple joints in performing a 
20 relatively complex work task. 

Still referring to FIG. 1, the controller 12 may be embodied 
as a server or a host machine having one or multiple digital 
computers or data processing devices, each having one or 
more microprocessors or central processing units (CPU), 
25 read only memory (ROM), random access memory (RAM), 
electrically-erasable programmable read only memory (EE- 
PROM), a high-speed clock, analog-to-digital (A/D) cir- 
cuitry, digital-to-analog (D/A) circuitry, and any required 
input/output (I/O) circuitry and devices, as well as signal 
30 conditioning and buffer electronics. Individual control algo- 
rithms resident in the controller 12 or readily accessible by the 
controller may be stored in ROM or other suitable memory 
and automatically executed to provide the respective control 
functionality. 

35 Referring to FIG. 2, a schematic control block diagram 32 
describes the basic operating principles of controller 12 of 
FIG. 1, which as noted above provides a control strategy for 
static compliance (control phase I) and, if so desired, for a 
dynamic reflex (control phase II). That is, the robot 1 1 of FIG. 
40 lisa force- or impedance-controlled robot, and therefore its 
behavior may be modeled as a mass spring-damper system. 
One may use a force- or an impedance-based control frame- 
work to specify desired stiffness, damping, and inertial prop- 
erties of the system as: 

45 

mx+bx+kAx =F 

where k is the spring constant, m is the mass being acted upon, 
b is a calibrated constant, F is the applied force to the mass, 
and Ax is the difference between an actual position and a 
50 desired position (x) of the mass. Force- or impedance-based 
control can provide robustness to a physical interaction 
between a robot and its surrounding environment, and pro- 
vides flexibility for diverse manipulation tasks. 

Block diagram 32 provides closed-loop control of the robot 
55 11 of FIG. 1 using various logic blocks and signal processing 
nodes. Beginning with node 48, this particular node receives 
a desired joint position 41, e.g., a desired joint angle (q rfei ), 
and a measured joint position 56, e.g., a measured joint angle 
(q) of a given robotic joint, and calculates the difference, e.g., 
60 (q rfej -q). The difference is transmitted as a position error 
signal 60 to a spring torque block 34, which calculates a 
required “spring” joint torque 62 which is proportional to the 
value of the position error signal 60. 

The required spring joint torque 62 constitutes the static 
65 torque/force applied by a given robotic manipulator to its 
surrounding environment. This signal is transmitted from 
spring torque block 34 to a limiting block 35, which provides 
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upper and lower bounds or saturation limits to the spring joint 
torque 62. Proprioceptive sensing may be used to determine 
force applied by the robot 11. As used herein, the term prop- 
rioceptive refers to a sensory modality providing feedback 
solely on the status of the robot 11 internally, i.e., a sense 
indicating whether the robotic is moving with a required 
effort, as well as where the various parts of the robot are 
located in relation to each other. External force sensing or 
detection of the contact force, i.e., exteroceptive sensing, is 
not required for this phase. The saturation-limited torque is 
transmitted as a torque signal 64 to another signal processing 
node 51, the function of which is described below. 

Block diagram 32 also includes adampingtorqueblock36, 
a dynamic compensation block 38, a gravity compensation 
block 40, and a contact detection block 42. Blocks 38, 40, and 
42 receive the measured joint position 56 as an input and 
separately generate different output signals. Damping torque 
block 36 receives the measured joint position 58 and provides 
an output torque signal 68. Signal 68 is proportional to the 
value Bq', where B is a calibrated proportionality constant 
and q' is the time derivative of the joint angle. Dynamic 
compensation block 38 generates a compensation signal 70 
which models dynamic forces, especially the Coriolus force, 
and compensates as needed. 

As is understood in the art, a Coriolus force is generated by 
the Coriolus effect acting on any object in motion in a rotating 
reference frame. It is proportional to the speed of rotation and 
of the reference frame, and to the object’s speed in the same 
reference frame, and it acts in a direction perpendicular to the 
rotation axis and to the velocity of the moving body in the 
rotating frame. Gravity compensation block 40 models the 
effects of gravity acting on the robot 11, and transmits this 
value as gravity compensation signal 72, which is ultimately 
subtracted by the processing node 51. 

Signal processing node 51 calculates a preliminary torque 
signal 66 as a function of the various signals 64, 68, 70, and 72 
from the respective blocks 35, 36, 38, and 40 as described 
above. The preliminary torque signal 66 is fed forward to a 
signal processing node 53, which ultimately calculates a joint 
torque command signal 50 for control of the robot 11. Node 
53 calculates the joint torque command signal 50 as a function 
of the preliminary torque signal 66 and a reflex torque signal 
78 from a reflex torque block 46. 

Still referring to FIG. 2, controller 12 may use contact 
detection block 42 to detect an external contact by modeling 
the dynamics of a particular robotic manipulator and/or by 
physically sensing an external force generated by an unex- 
pected contact between the robot 11 and an object encoun- 
tered in its unstructured workspace. Exteroceptive sensing 
may be used to detect such contact, with the term “exterocep- 
tive” referring to detection of the contact force from outside of 
the robot 11 using such means as vision sensing, load cells, 
range-finding, etc. It may accept such inputs as the measured 
joint positions 56 and a sensed or measured external force 54. 
with the arrow of force 54 in FIG. 2 indicating that this value 
may be fed forward for use by the controller 12 as needed. 

A contact force signal 74 from block 42 may be processed 
via a threshold comparison block 44 to generate a reflex 
command signal 76. When a reflex torque is required, i.e., 
when the external force of the contact detected at block 42 
exceeds the threshold force of block 44, the reflex torque 
block 46 initiates a desired reflex response, which is trans- 
mitted to node 53 as the reflex torque signal 78. The actual 
desired reflex can take on many forms, such as generating a 
torque to pull back from the contact. 

Node 53 then calculates the joint torque command signal 
50 as a function of the preliminary joint torque 66 and the 
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reflex torque signal 78. Robot 11 is commanded via joint 
torque command signal 50 to produce the required force joint 
torque. It may feedback any sensed or measured values for the 
measured external force 54 and joint position 56. 

5 The control law as expressed in FIG. 2 is formulated in the 
joint-space of the robot 11 of FIG. 1, i.e., with respect to the 
joint degrees-of-freedom (DOF) of the robot. That is, the 
saturation limit described by FIG. 2 is defined with respect to 
at least one of a joint torque and a Cartesian force and moment 
to at a selected point on the robotic manipulator of the robot 11. 
In the latter case, control may be formulated in the operational 
space of the robot 11, i.e., with respect to the Cartesian DOF 
of an end-effector of the robot. In such a case, the saturation 
limits apply to the Cartesian forces/moments applied by the 
15 robot 1 1 rather than to the joint torques. 

Referring to FIG. 3, algorithm 100 provides one possible 
way of executing the control strategy set forth above. Algo- 
rithm 100 begins with step 102, wherein the controller 12 of 
FIG. 1 automatically imposes a saturation limit on the static 
20 force that can be applied by a given manipulator of the robot 
11, i.e., by a finger, thumb, hand, or other manipulator, such 
that this limit cannot be exceeded at any time. In other words, 
the controller 12 automatically saturates the virtual “spring 
force” in an impedance-based framework as noted above, 
25 e.g., limiting joint torques via the saturation limit block 35 
described above. The robot 11 will comply with its environ- 
ment without fighting through obstacles it might happen to 
contact in its workspace. Step 102 provides inherent work- 
space safety, as it is always running and does not require 
30 contact or proximity detection. 

At step 104, the controller 12 may also determine if a 
threshold contact force is present. For example, the contact 
detection block 42 of FIG. 2 may be used to detect a contact 
between the robot 1 1 and an object using modeling dynamics 
35 and/or by sensing the contact force as noted above. The com- 
parison block 44 can be used to make the threshold decision 
and to communicate the decision within the controller 12 as to 
whether or not a dynamic reflex should be initiated. 

At step 106, the controller 12 imposes a dynamic reflex on 
40 the robot 1 1 . Due to inertia, the robot 1 1 will impart a higher 
dynamic force upon contact with an object in its workspace. 
If the contact force exceeds a threshold, controller 12 initiates 
the calibrated reflex via reflex block 46. The algorithm 100 
proceeds to step 108. 

45 At step 108, the controller 12 discontinues the dynamic 
reflex and switches back to only the static compliance of step 
102. That is, while controller 12 continues to monitor contact 
in the workspace, it defaults to control phase I, i.e., static 
monitoring per block 34. 

50 Using algorithm 100 when executed according to logic 
diagram 32 of FIG. 2, safe operation is enabled in an unstruc- 
tured work environment shared between dexterous robots 
such as the robot 11, human operators, and any unfixtured 
objects. The impedance framework with the continuous static 
55 compliance ensures that compliance is always in operation, 
without the need for awareness of the environment. The 
optional dynamic reflex phase can be used to reduce the 
contact force occurring with fast motion of the robot 11 to 
within a calibrated control bandwidth. 

60 While the best modes for carrying out the invention have 
been described in detail, those familiar with the art to which 
this invention relates will recognize various alternative 
designs and embodiments for practicing the invention within 
the scope of the appended claims. 

65 The invention claimed is: 

1. A method of controlling a force- or impedance-con- 
trolled robot having a controller and a robotic manipulator, 
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wherein the robotic manipulator includes a robotic joint that 
is moveable via a joint actuator, and wherein the robot oper- 
ates within an unstructured workspace, the method compris- 
ing: 

proprioceptively sensing a static force applied by the 
robotic manipulator to its surrounding environment; 

automatically imposing, via the controller, a saturation 
limit on the static force applied by the robotic manipu- 
lator to its surrounding environment at all times such that 
the static force cannot at any time exceed the saturation 
limit; 

calculating a reflex torque to be imparted by the joint 
actuator to the robotic joint in response to contact 
between the robotic manipulator and the object in the 
unstructured workspace; 

determining a contact force between the robotic manipu- 
lator and an object when the robotic manipulator makes 
contact with the object; and 

automatically applying the calculated reflex torque to the 
robotic joint via the joint actuator as a dynamic reflex 
when the contact force exceeds a calibrated threshold. 

2. The method of claim 1, wherein the saturation limit is 
defined with respect to at least one of a torque in the robotic 
joint of the robotic manipulator and a Cartesian force and 
moment at a selected point on the robotic manipulator. 

3. The method of claim 1, further comprising identifying 
the contact with the object using at least one of: modeling 
dynamics of the robotic manipulator and sensing when the 
contact force exceeds the calibrated threshold. 

4. The method of claim 1, further comprising using extero- 
ceptive sensing to sense the contact force. 

5. The method of claim 1, further comprising discontinuing 
the dynamic reflex when the contact force decreases below 
the calibrated threshold. 

6. The method of claim 1, further comprising: 

automatically compensating for a gravitational force and a 

Coriolus force acting on the robotic manipulator in cal- 
culating the reflex torque. 

7. A robotic system comprising: 

a force- or impedance-controlled robot having a robotic 
manipulator and an unstructured workspace, wherein 
the robotic manipulator includes a robotic joint that is 
moveable via a joint actuator; and 

a controller that is electrically connected to the robotic 
manipulator and adapted to control the robotic manipu- 
lator using force- or impedance-based commands; 

wherein the controller is configured to: 

proprioceptively sense a static force applied by the 
robotic manipulator to its surrounding environment, 
and imposes a saturation limit on the static force 
applied by the manipulator to its surrounding envi- 
ronment at all times such that the static force cannot at 
any time exceed the saturation limit; 
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calculate a reflex torque to be imparted by the joint 
actuator to the robotic joint when the robotic manipu- 
lator contacts an object in the unstructured work- 
space; and 

5 command the calculated reflex torque as a dynamic 
reflex of the robotic manipulator when the robotic 
manipulator contacts the object in the unstructured 
workspace with a contact force that exceeds a cali- 
brated threshold. 

111 8. The robotic system of claim 7, wherein the saturation 

limit is defined with respect to at least one of a torque in the 
robotic joint of the robotic manipulator, and a C artesian force 
and moment on a selected point on the robotic manipulator. 

1 . 9. The robotic system of claim 7, wherein the controller 

identifies a contact between the robotic manipulator and the 
object using at least one of: 

modeling of dynamics of the robotic manipulator and sens- 
ing when the contact force exceeds the calibrated thresh- 

20 ° ld ' 

10. The robotic system of claim 7, wherein the controller 
automatically discontinues the dynamic reflex when the con- 
tact force decreases below the calibrated threshold. 

1 1 . A controller for a force- or impedance-controlled robot 
, _ operating in an unstructured workspace and having a robotic 

manipulator, wherein the robotic manipulator includes a 
robotic joint that is moveable via a joint actuator, and wherein 
the controller includes a host machine that is programmed to: 
proprioceptively sense a static force applied by the robotic 
30 manipulator to its surrounding environment; 

automatically impose a saturation limit on the static force 
applied by the robotic manipulator to its surrounding 
environment at all times, such that the static force cannot 
at any time exceed the saturation limit; 

35 calculate a reflex torque to be imparted by the joint actuator 

to the robotic joint in the event the robotic manipulator 
contacts an object in the unstructured workspace; and 
command the calculated reflex torque as a dynamic reflex 
when the robotic manipulator contacts the object with a 
„„ contact force that exceeds a calibrated threshold. 

12. The controller of claim 11, wherein the saturation limit 

is defined with respect to at least one of a torque in the robotic 

joint of the robotic manipulator and a Cartesian force and 

moment at a selected point on the robotic manipulator. 

. . 13. The controller of claim 11, wherein the host machine is 
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further programmed to identify contact between the robotic 
manipulator and the object using at least one of: modeling 
dynamics of the robotic manipulator and sensing when the 
contact force exceeds the calibrated threshold. 

- n 14. The controller of claim 11, wherein the controller dis- 
continues the dynamic reflex when the contact force 
decreases below the calibrated threshold. 





